#include "WPILib.h"
#include "Function.cpp"
#include "string.h"

	void RobotDemo::Autonomous(void)
	{
		myRobot.SetSafetyEnabled(false);
		GyroTurn();	
		
	}
	void RobotDemo::OperatorControl(void)
	{
		myRobot.SetSafetyEnabled(true);
		while (IsOperatorControl())
		{
			myRobot.TankDrive( leftStick.GetRawAxis(2), rightStick.GetRawAxis(5) ); // drive with arcade style (use right stick)
			Wait(0.005);				// wait for a motor update time
		}
	}

START_ROBOT_CLASS(RobotDemo);

